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Abstract 


In experimental robotics , researchers may face uncertainties in parameters of a robot ma¬ 
nipulator that they are working with. This uncertainty may be caused by deviations in the 
manufacturing process of a manipulator; or changes applied to manipulator in the lab for 
sake of experiments. Another situation when dynamical and inertial parameters of a robot are 
uncertain arises , is the grasping of objects by a manipulator. In all these situations there is 
a need for adaptive control strategies that would identify changes in dynamical properties of 
manipulator and adjust for them. This article presents a work on designing of an adaptive 
control strategy for 4-DoF manipulator with uncertain dynamical properties , and outcomes of 
testing of this strategy applied to control of simulator of robot. 


I. Introduction 

This article presents an adaptive control 
strategy for 4-DoF manipulator, where 
some dynamical parameters of a manip¬ 
ulator are considered not to be known pre¬ 
cisely. Also it is considered that there is 
no way to measure these parameters other 
than start controlling and trying to deter¬ 
mining precise values of parameter while 
manipulator executing some tasks. So, the 
proposed controlling strategy must have 
integrated online recursive parameter iden¬ 
tification. 

To derive the strategy, first the kinemat¬ 
ics of manipulator is explained. The kine¬ 
matics is necessary to derive then inverse 
dynamics equations of manipulator, which 
are then used then to implement adaptive 
torque controller. The final section of this 
article is dedicated to simulation and test¬ 
ing of the proposed strategy. 
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There are number of adaptive con¬ 
trol strategies described in literature (see 
[Lewis, 2011]). But the distinguishing fea¬ 
ture of the proposed strategy is that it fo¬ 
cuses on identification of parameters that 
are related to position of centers of masses 
in manipulator bodies. 

II. Strategy 
I. Kinematics 

A normal way to describe robot kinematics 
is to use Danavit and Hartenberg param¬ 
eters. The given robot manipulator rep¬ 
resent an anthropomorphic leg. Four de¬ 
grees of freedom are distributed in the fol¬ 
lowing way three revolute joints combined 
into one in foundation of the hip y and one 
re volute joint in the knee-.- The three com¬ 
bined revolute joints act as spherical joint 
in hip of a human for instances. In real 
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robotic manipulators it would be possible 
to mergeall three joints into points, and 
they have to be separated by some phys¬ 
ical links. But since this the target of the 
work was to simulate adaptive control strat- 
egy,and merging all of them into one sim¬ 


plifies derivation of robot dynamics greatly, 
it was decided to merge them into 3-dof 
z-y-x joint with zero length links. Table 1 
contains the DH parameters of the robot. 
Further the straightforward equations of 
robot kinematics are given. 
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Table 1: DH-parameters of robot kinematics 
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Where R x ,R y ,R z are rotational matrices. 

To illustrate kinematics of manipu¬ 
lator, a visualization of manipulator in 
some sample configuration is given below. 



II. Dynamics 

Robot dynamics is derived using 
Lagrangian-Euler mechanics. Lagrange's 
equation of motion for a conservative sys¬ 
tem are given by 

ddL _dL _ 
dt dq dq 

where L — K — P, r is a vector of gener¬ 
alized forces, q is a joint variables vectors, 
K is kinetic energy of the system, P is a 
potential energy. A more standard form of 
manipulator dynamics is 

M(q)cj + C(q, q) + G(q) = r 
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where M(q) is the inertia matrix, C(q, q) is Where 
Coriolis/centripetal vector, and G(q) is the 
gravity vector. 

For the given kinematics of a robot the 
Lagrangian can be derived by 
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So we can parametrize W(q,q,q) as 


W\q,q,q) = ®(q,q,q)(0' • 6) = 0'(q,q,q)6 


At the end 


d_3L _ dL 
dt dq dq 


W(q,q,q) = r 


So the parametrarized inverse dynamics 
looks like: 


< I >\q,q,q)0 = r 


III. Parametrization 

To implement parameter identification al¬ 
gorithm, the manipulator dynamics has 
to be parametrized linearly The goal 
of this project to design a strategy that 
would adapt to uncertain model param¬ 
eters, which are center of masses of linked 
bodies in manipulator. It is not possible 
to factor out positions if center of masses 
from the inverse dynamic of a manipulator 
directly, as the dynamics equation is non¬ 
linear in relation to coordinates of center 
of masses. However it is possible multiple 
these nonlinear terms to some parameters 
and through this was to adjust inverse dy¬ 
namics equation of the system. So then W 
can be factored as 

W(q,q,cj) = ®(q,q,cj)d' 


IV. Computed Torque Controller 

In foundation of the described control strat¬ 
egy lays a computed torque controller. A 
idea behind a computed torque controller 
is to cascade non-linear system with its in¬ 
verse so the overall system has constant 
unity gain. In practice the inverse is not 
perfect so a feedback loop is required to 
deal with errors. The computed torque 
controller is given by: 

o' (q + K p e, q + K d e, q)d = r 

Where K p and K v are position and velocity 
gains matrices, e = q* — q is position error. 

V. Parameters Identification 

The recursive least squares algorithm is 
used for parameter estimation. As it is 
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the easiest way most reliable way for pa¬ 
rameter estimation in the proposed control 
strategy. 

W(q, q,q) = ®'(q,q,q)6 
Or at some z-th step: 

w; = = n 

So the RLS scheme can be expressed in the 
following steps: 

di = of_ 1 +K i (T i -6' t eU) (i) 

Ki = pA = Pi-A(I + A) (2) 

Pi = Pi _! - Pi-^I + ^Pi_^i)-APi-i 

( 3 ) 

The RLS parameter estimation was imple¬ 
mented as a part of a model controller. The 
figure [l] is actual simulink model of con¬ 
troller and simulated manipulator. The 
central block called "Interpreted MATLAB 
Fen" is matlab implementation of robot in¬ 
verse dynamics together with RLS parame¬ 
ter estimation. This block is implemented 


using persistent variables used to memo¬ 
rize one step ahead K, P and 6 values of 
RLS estimator. 

III. Simulation and Evaluation 

The described control strategy was tested 
on a MATLAB simulink model. The refer¬ 
ence model of manipulator was powered 
by Peter Corke's robotics library, which 
is based on recursive Newton-Euler artic¬ 
ulated body algorithm. The torque con¬ 
troller was computed symbolically from 
Lagrangian of a manipulator that had 
slightly different inertial parameters than 
reference model. The built simulink model 
has the following features: 

• Kp and K v are fixed at some val¬ 
ues, that were learned empirically by 
looking at optimal controllability and 
stability of reference model. 

• The output of controller is discretized 
using ZOH, at a rate of 100Hz. 

• The reference trajectory is generated 
by interpolation between two joints 
space states 

The implemented simulink model is 
show on the picture [lj 


4 


C-kJLhi 





t 



► 


h- 

Ini er pasted 
MATLAB Fon 

J 

1 

U 

W 



I i-iluf printed KiATLAB 
Fund Kin 


► 


J 1 - 


Tfb 


► 


Rnr^midm 1 bivSrnalKin 



Figure 1: Matlab Simulation of Controller 


IV. Results 

The number of simulations were per¬ 
formed that shown that presented control 
strategy is viable and stable enough. In 
number of experiments, model parameters 


converged to some fixed valued. However 
the presented strategy has to be researched 
much further than the author was able to 
do for the project to conclude fully about 
effectiveness of the proposed strategy. 
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Figure 2 : Example output of computed torque controller 



Figure 3: Joint trajectories of controlled robot 









Figure 4: Square error in online parameter estimation 
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